<?xml version="1.0" encoding="utf-8"?>
<SimulationState xmlns:s="http://www.w3.org/2003/05/soap-envelope" xmlns:wsa="http://schemas.xmlsoap.org/ws/2004/08/addressing" xmlns:d="http://schemas.microsoft.com/xw/2004/10/dssp.html" xmlns="http://schemas.microsoft.com/robotics/2006/04/simulation.html">
  <Gravity>
    <X xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">0</X>
    <Y xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">-9.81</Y>
    <Z xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">0</Z>
  </Gravity>
  <RenderMode>Full</RenderMode>
  <FramesPerSecond>60.0392265</FramesPerSecond>
  <Pause>false</Pause>
  <CameraPosition>
    <X xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">3.39</X>
    <Y xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">0.47</Y>
    <Z xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">1.52</Z>
  </CameraPosition>
  <CameraLookAt>
    <X xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">2.41</X>
    <Y xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">0.53</Y>
    <Z xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">0.68</Z>
  </CameraLookAt>
  <CameraFieldOfView>0.781</CameraFieldOfView>
  <CameraNearPlane>0.1</CameraNearPlane>
  <CameraFarPlane>5000</CameraFarPlane>
  <Lights>
    <LightEntity>
      <Name>Sun</Name>
      <Type>Directional</Type>
      <Color>
        <X xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">1</X>
        <Y xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">1</Y>
        <Z xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">1</Z>
        <W xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">1</W>
      </Color>
      <Pose>
        <Position xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">
          <X>-1</X>
          <Y>0.6</Y>
          <Z>-0.1</Z>
        </Position>
        <Orientation xmlns="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html">
          <X>0</X>
          <Y>0</Y>
          <Z>0</Z>
          <W>0</W>
        </Orientation>
      </Pose>
    </LightEntity>
  </Lights>
  <SerializedEntities>
    <HeightFieldEntity xmlns:sim="http://schemas.microsoft.com/robotics/2006/04/simulation.html" xmlns:physm="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html" xmlns:phys="http://schemas.microsoft.com/robotics/2006/04/simulation/physics.html" xmlns="http://schemas.microsoft.com/robotics/2006/04/simulationengine.html">
      <sim:State>
        <sim:Name>ground</sim:Name>
        <sim:Assets>
          <sim:DefaultTexture>03RamieSc.dds</sim:DefaultTexture>
          <sim:Effect>default</sim:Effect>
        </sim:Assets>
        <sim:Pose>
          <physm:Position>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </physm:Position>
          <physm:Orientation>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
            <physm:W>1</physm:W>
          </physm:Orientation>
        </sim:Pose>
        <sim:Velocity>
          <physm:X>0</physm:X>
          <physm:Y>0</physm:Y>
          <physm:Z>0</physm:Z>
        </sim:Velocity>
        <sim:MassDensity>
          <phys:Mass>0</phys:Mass>
          <phys:InertiaTensor>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:InertiaTensor>
          <phys:CenterOfMass>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>0</physm:W>
            </physm:Orientation>
          </phys:CenterOfMass>
          <phys:Density>0</phys:Density>
          <phys:LinearDamping>0</phys:LinearDamping>
          <phys:AngularDamping>0</phys:AngularDamping>
        </sim:MassDensity>
        <sim:Flags>Dynamic</sim:Flags>
      </sim:State>
      <Flags>Ground</Flags>
      <ChildCount>0</ChildCount>
      <HeightFieldShape>
        <phys:HeightFieldState>
          <phys:Name>ground/height field</phys:Name>
          <phys:ShapeId>HeightField</phys:ShapeId>
          <phys:Dimensions>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:Dimensions>
          <phys:Radius>0</phys:Radius>
          <phys:Material>
            <phys:Name>ground</phys:Name>
            <phys:Restitution>0.8</phys:Restitution>
            <phys:DynamicFriction>0.5</phys:DynamicFriction>
            <phys:StaticFriction>0.8</phys:StaticFriction>
            <phys:MaterialIndex>2</phys:MaterialIndex>
          </phys:Material>
          <phys:MassDensity>
            <phys:Mass>0</phys:Mass>
            <phys:InertiaTensor>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:InertiaTensor>
            <phys:CenterOfMass>
              <physm:Position>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>0</physm:W>
              </physm:Orientation>
            </phys:CenterOfMass>
            <phys:Density>0</phys:Density>
            <phys:LinearDamping>0</phys:LinearDamping>
            <phys:AngularDamping>0</phys:AngularDamping>
          </phys:MassDensity>
          <phys:LocalPose>
            <physm:Position>
              <physm:X>-3200</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>-3200</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>1</physm:W>
            </physm:Orientation>
          </phys:LocalPose>
          <phys:TextureFileName />
          <phys:DiffuseColor>
            <physm:X>0.5</physm:X>
            <physm:Y>0.5</physm:Y>
            <physm:Z>0.5</physm:Z>
            <physm:W>1</physm:W>
          </phys:DiffuseColor>
          <phys:EnableContactNotifications>false</phys:EnableContactNotifications>
          <phys:HeightScale>1</phys:HeightScale>
          <phys:RowScale>100</phys:RowScale>
          <phys:ColumnScale>100</phys:ColumnScale>
          <phys:MaterialIndexHigh>0</phys:MaterialIndexHigh>
          <phys:HoleMaterialIndex>0</phys:HoleMaterialIndex>
          <phys:ColumnCount>64</phys:ColumnCount>
          <phys:RowCount>64</phys:RowCount>
          <phys:VerticalExtent>-1000</phys:VerticalExtent>
          <phys:ConvexEdgeThreshold>0</phys:ConvexEdgeThreshold>
          <phys:TextureUScale>100</phys:TextureUScale>
          <phys:TextureVScale>100</phys:TextureVScale>
        </phys:HeightFieldState>
      </HeightFieldShape>
    </HeightFieldEntity>
    <SingleShapeEntity xmlns:sim="http://schemas.microsoft.com/robotics/2006/04/simulation.html" xmlns:physm="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html" xmlns:phys="http://schemas.microsoft.com/robotics/2006/04/simulation/physics.html" xmlns="http://schemas.microsoft.com/robotics/2006/04/simulationengine.html">
      <sim:State>
        <sim:Name>StreetCone</sim:Name>
        <sim:Assets>
          <sim:Mesh>street_cone.obj</sim:Mesh>
          <sim:Effect>default</sim:Effect>
        </sim:Assets>
        <sim:Pose>
          <physm:Position>
            <physm:X>0.700007558</physm:X>
            <physm:Y>0.3480001</physm:Y>
            <physm:Z>-3.99999428</physm:Z>
          </physm:Position>
          <physm:Orientation>
            <physm:X>-2.56998955E-09</physm:X>
            <physm:Y>-3.01586988E-06</physm:Y>
            <physm:Z>-1.85908178E-07</physm:Z>
            <physm:W>1</physm:W>
          </physm:Orientation>
        </sim:Pose>
        <sim:Velocity>
          <physm:X>0</physm:X>
          <physm:Y>0</physm:Y>
          <physm:Z>0</physm:Z>
        </sim:Velocity>
        <sim:MassDensity>
          <phys:Mass>0.5</phys:Mass>
          <phys:InertiaTensor>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:InertiaTensor>
          <phys:CenterOfMass>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>0</physm:W>
            </physm:Orientation>
          </phys:CenterOfMass>
          <phys:Density>0</phys:Density>
          <phys:LinearDamping>0</phys:LinearDamping>
          <phys:AngularDamping>0</phys:AngularDamping>
        </sim:MassDensity>
        <sim:Flags>Dynamic</sim:Flags>
      </sim:State>
      <Flags>None</Flags>
      <ChildCount>0</ChildCount>
      <BoxShape>
        <phys:BoxState>
          <phys:Name>StreetCone</phys:Name>
          <phys:ShapeId>Box</phys:ShapeId>
          <phys:Dimensions>
            <physm:X>0.45</physm:X>
            <physm:Y>0.7</physm:Y>
            <physm:Z>0.45</physm:Z>
          </phys:Dimensions>
          <phys:Radius>0</phys:Radius>
          <phys:MassDensity>
            <phys:Mass>0.5</phys:Mass>
            <phys:InertiaTensor>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:InertiaTensor>
            <phys:CenterOfMass>
              <physm:Position>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>0</physm:W>
              </physm:Orientation>
            </phys:CenterOfMass>
            <phys:Density>0</phys:Density>
            <phys:LinearDamping>0</phys:LinearDamping>
            <phys:AngularDamping>0</phys:AngularDamping>
          </phys:MassDensity>
          <phys:LocalPose>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>1</physm:W>
            </physm:Orientation>
          </phys:LocalPose>
          <phys:TextureFileName />
          <phys:DiffuseColor>
            <physm:X>0.5</physm:X>
            <physm:Y>0.5</physm:Y>
            <physm:Z>0.5</physm:Z>
            <physm:W>1</physm:W>
          </phys:DiffuseColor>
          <phys:EnableContactNotifications>false</phys:EnableContactNotifications>
        </phys:BoxState>
      </BoxShape>
    </SingleShapeEntity>
    <SingleShapeEntity xmlns:sim="http://schemas.microsoft.com/robotics/2006/04/simulation.html" xmlns:physm="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html" xmlns:phys="http://schemas.microsoft.com/robotics/2006/04/simulation/physics.html" xmlns="http://schemas.microsoft.com/robotics/2006/04/simulationengine.html">
      <sim:State>
        <sim:Name>greybox</sim:Name>
        <sim:Assets>
          <sim:Effect>default</sim:Effect>
        </sim:Assets>
        <sim:Pose>
          <physm:Position>
            <physm:X>-2.004856</physm:X>
            <physm:Y>0.7480039</physm:Y>
            <physm:Z>-1.00067806</physm:Z>
          </physm:Position>
          <physm:Orientation>
            <physm:X>2.43807358E-06</physm:X>
            <physm:Y>5.4754375E-05</physm:Y>
            <physm:Z>-2.44424655E-07</physm:Z>
            <physm:W>1</physm:W>
          </physm:Orientation>
        </sim:Pose>
        <sim:Velocity>
          <physm:X>0</physm:X>
          <physm:Y>0</physm:Y>
          <physm:Z>0</physm:Z>
        </sim:Velocity>
        <sim:MassDensity>
          <phys:Mass>10</phys:Mass>
          <phys:InertiaTensor>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:InertiaTensor>
          <phys:CenterOfMass>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>0</physm:W>
            </physm:Orientation>
          </phys:CenterOfMass>
          <phys:Density>0</phys:Density>
          <phys:LinearDamping>0</phys:LinearDamping>
          <phys:AngularDamping>0</phys:AngularDamping>
        </sim:MassDensity>
        <sim:Flags>Dynamic</sim:Flags>
      </sim:State>
      <Flags>None</Flags>
      <ChildCount>0</ChildCount>
      <BoxShape>
        <phys:BoxState>
          <phys:Name>greybox</phys:Name>
          <phys:ShapeId>Box</phys:ShapeId>
          <phys:Dimensions>
            <physm:X>1</physm:X>
            <physm:Y>1.5</physm:Y>
            <physm:Z>0.5</physm:Z>
          </phys:Dimensions>
          <phys:Radius>0</phys:Radius>
          <phys:Material>
            <phys:Name>gbox</phys:Name>
            <phys:Restitution>0.5</phys:Restitution>
            <phys:DynamicFriction>0.4</phys:DynamicFriction>
            <phys:StaticFriction>0.5</phys:StaticFriction>
            <phys:MaterialIndex>2</phys:MaterialIndex>
          </phys:Material>
          <phys:MassDensity>
            <phys:Mass>10</phys:Mass>
            <phys:InertiaTensor>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:InertiaTensor>
            <phys:CenterOfMass>
              <physm:Position>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>0</physm:W>
              </physm:Orientation>
            </phys:CenterOfMass>
            <phys:Density>0</phys:Density>
            <phys:LinearDamping>0</phys:LinearDamping>
            <phys:AngularDamping>0</phys:AngularDamping>
          </phys:MassDensity>
          <phys:LocalPose>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>1</physm:W>
            </physm:Orientation>
          </phys:LocalPose>
          <phys:TextureFileName />
          <phys:DiffuseColor>
            <physm:X>0.5</physm:X>
            <physm:Y>0.5</physm:Y>
            <physm:Z>0.5</physm:Z>
            <physm:W>1</physm:W>
          </phys:DiffuseColor>
          <phys:EnableContactNotifications>false</phys:EnableContactNotifications>
        </phys:BoxState>
      </BoxShape>
    </SingleShapeEntity>
    <SingleShapeEntity xmlns:sim="http://schemas.microsoft.com/robotics/2006/04/simulation.html" xmlns:physm="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html" xmlns:phys="http://schemas.microsoft.com/robotics/2006/04/simulation/physics.html" xmlns="http://schemas.microsoft.com/robotics/2006/04/simulationengine.html">
      <sim:State>
        <sim:Name>bluesphere</sim:Name>
        <sim:Assets>
          <sim:Effect>default</sim:Effect>
        </sim:Assets>
        <sim:Pose>
          <physm:Position>
            <physm:X>-2</physm:X>
            <physm:Y>0.798</physm:Y>
            <physm:Z>-3</physm:Z>
          </physm:Position>
          <physm:Orientation>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>-9.697828E-08</physm:Z>
            <physm:W>1</physm:W>
          </physm:Orientation>
        </sim:Pose>
        <sim:Velocity>
          <physm:X>0</physm:X>
          <physm:Y>0</physm:Y>
          <physm:Z>0</physm:Z>
        </sim:Velocity>
        <sim:MassDensity>
          <phys:Mass>10</phys:Mass>
          <phys:InertiaTensor>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:InertiaTensor>
          <phys:CenterOfMass>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>0</physm:W>
            </physm:Orientation>
          </phys:CenterOfMass>
          <phys:Density>0</phys:Density>
          <phys:LinearDamping>0</phys:LinearDamping>
          <phys:AngularDamping>0</phys:AngularDamping>
        </sim:MassDensity>
        <sim:Flags>Dynamic</sim:Flags>
      </sim:State>
      <Flags>None</Flags>
      <ChildCount>0</ChildCount>
      <SphereShape>
        <phys:SphereState>
          <phys:Name>bluesphere</phys:Name>
          <phys:ShapeId>Sphere</phys:ShapeId>
          <phys:Dimensions>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:Dimensions>
          <phys:Radius>0.8</phys:Radius>
          <phys:Material>
            <phys:Name>bphere</phys:Name>
            <phys:Restitution>0.5</phys:Restitution>
            <phys:DynamicFriction>0.4</phys:DynamicFriction>
            <phys:StaticFriction>0.5</phys:StaticFriction>
            <phys:MaterialIndex>2</phys:MaterialIndex>
          </phys:Material>
          <phys:MassDensity>
            <phys:Mass>10</phys:Mass>
            <phys:InertiaTensor>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:InertiaTensor>
            <phys:CenterOfMass>
              <physm:Position>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>0</physm:W>
              </physm:Orientation>
            </phys:CenterOfMass>
            <phys:Density>0</phys:Density>
            <phys:LinearDamping>0</phys:LinearDamping>
            <phys:AngularDamping>0</phys:AngularDamping>
          </phys:MassDensity>
          <phys:LocalPose>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>1</physm:W>
            </physm:Orientation>
          </phys:LocalPose>
          <phys:TextureFileName />
          <phys:DiffuseColor>
            <physm:X>0.4</physm:X>
            <physm:Y>0.3</physm:Y>
            <physm:Z>0.7</physm:Z>
            <physm:W>1</physm:W>
          </phys:DiffuseColor>
          <phys:EnableContactNotifications>false</phys:EnableContactNotifications>
        </phys:SphereState>
      </SphereShape>
    </SingleShapeEntity>
    <SkyEntity xmlns:sim="http://schemas.microsoft.com/robotics/2006/04/simulation.html" xmlns:physm="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html" xmlns:phys="http://schemas.microsoft.com/robotics/2006/04/simulation/physics.html" xmlns="http://schemas.microsoft.com/robotics/2006/04/simulationengine.html">
      <sim:State>
        <sim:Name>Sky</sim:Name>
        <sim:Assets>
          <sim:Effect>SkyBox.fx</sim:Effect>
        </sim:Assets>
        <sim:Pose>
          <physm:Position>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </physm:Position>
          <physm:Orientation>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
            <physm:W>1</physm:W>
          </physm:Orientation>
        </sim:Pose>
        <sim:Velocity>
          <physm:X>0</physm:X>
          <physm:Y>0</physm:Y>
          <physm:Z>0</physm:Z>
        </sim:Velocity>
        <sim:MassDensity>
          <phys:Mass>0</phys:Mass>
          <phys:InertiaTensor>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:InertiaTensor>
          <phys:CenterOfMass>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>0</physm:W>
            </physm:Orientation>
          </phys:CenterOfMass>
          <phys:Density>0</phys:Density>
          <phys:LinearDamping>0</phys:LinearDamping>
          <phys:AngularDamping>0</phys:AngularDamping>
        </sim:MassDensity>
        <sim:Flags>Dynamic</sim:Flags>
      </sim:State>
      <Flags>None</Flags>
      <ChildCount>0</ChildCount>
      <VisualTexture>sky.dds</VisualTexture>
      <LightingTexture>sky_diff.dds</LightingTexture>
    </SkyEntity>
    <SingleShapeEntity xmlns:sim="http://schemas.microsoft.com/robotics/2006/04/simulation.html" xmlns:physm="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html" xmlns:phys="http://schemas.microsoft.com/robotics/2006/04/simulation/physics.html" xmlns="http://schemas.microsoft.com/robotics/2006/04/simulationengine.html">
      <sim:State>
        <sim:Name>texbox</sim:Name>
        <sim:Assets>
          <sim:DefaultTexture>env2.bmp</sim:DefaultTexture>
          <sim:Effect>default</sim:Effect>
        </sim:Assets>
        <sim:Pose>
          <physm:Position>
            <physm:X>-4.00483561</physm:X>
            <physm:Y>0.7480254</physm:Y>
            <physm:Z>-1.0006814</physm:Z>
          </physm:Position>
          <physm:Orientation>
            <physm:X>3.67224084E-06</physm:X>
            <physm:Y>6.04056222E-05</physm:Y>
            <physm:Z>-1.01123915E-05</physm:Z>
            <physm:W>1</physm:W>
          </physm:Orientation>
        </sim:Pose>
        <sim:Velocity>
          <physm:X>0</physm:X>
          <physm:Y>0</physm:Y>
          <physm:Z>0</physm:Z>
        </sim:Velocity>
        <sim:MassDensity>
          <phys:Mass>10</phys:Mass>
          <phys:InertiaTensor>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:InertiaTensor>
          <phys:CenterOfMass>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>0</physm:W>
            </physm:Orientation>
          </phys:CenterOfMass>
          <phys:Density>0</phys:Density>
          <phys:LinearDamping>0</phys:LinearDamping>
          <phys:AngularDamping>0</phys:AngularDamping>
        </sim:MassDensity>
        <sim:Flags>Dynamic</sim:Flags>
      </sim:State>
      <Flags>None</Flags>
      <ChildCount>0</ChildCount>
      <BoxShape>
        <phys:BoxState>
          <phys:Name>texbox</phys:Name>
          <phys:ShapeId>Box</phys:ShapeId>
          <phys:Dimensions>
            <physm:X>1</physm:X>
            <physm:Y>1.5</physm:Y>
            <physm:Z>0.5</physm:Z>
          </phys:Dimensions>
          <phys:Radius>0</phys:Radius>
          <phys:Material>
            <phys:Name>tbox</phys:Name>
            <phys:Restitution>0.5</phys:Restitution>
            <phys:DynamicFriction>0.4</phys:DynamicFriction>
            <phys:StaticFriction>0.5</phys:StaticFriction>
            <phys:MaterialIndex>3</phys:MaterialIndex>
          </phys:Material>
          <phys:MassDensity>
            <phys:Mass>10</phys:Mass>
            <phys:InertiaTensor>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:InertiaTensor>
            <phys:CenterOfMass>
              <physm:Position>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>0</physm:W>
              </physm:Orientation>
            </phys:CenterOfMass>
            <phys:Density>0</phys:Density>
            <phys:LinearDamping>0</phys:LinearDamping>
            <phys:AngularDamping>0</phys:AngularDamping>
          </phys:MassDensity>
          <phys:LocalPose>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>1</physm:W>
            </physm:Orientation>
          </phys:LocalPose>
          <phys:TextureFileName />
          <phys:DiffuseColor>
            <physm:X>0.5</physm:X>
            <physm:Y>0.5</physm:Y>
            <physm:Z>0.5</physm:Z>
            <physm:W>1</physm:W>
          </phys:DiffuseColor>
          <phys:EnableContactNotifications>false</phys:EnableContactNotifications>
        </phys:BoxState>
      </BoxShape>
    </SingleShapeEntity>
    <SingleShapeEntity xmlns:sim="http://schemas.microsoft.com/robotics/2006/04/simulation.html" xmlns:physm="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html" xmlns:phys="http://schemas.microsoft.com/robotics/2006/04/simulation/physics.html" xmlns="http://schemas.microsoft.com/robotics/2006/04/simulationengine.html">
      <sim:State>
        <sim:Name>goldencapsule</sim:Name>
        <sim:Assets>
          <sim:Effect>default</sim:Effect>
        </sim:Assets>
        <sim:Pose>
          <physm:Position>
            <physm:X>-1.99940562</physm:X>
            <physm:Y>1.49799955</physm:Y>
            <physm:Z>-5.00003624</physm:Z>
          </physm:Position>
          <physm:Orientation>
            <physm:X>2.440144E-06</physm:X>
            <physm:Y>-1.29752407E-05</physm:Y>
            <physm:Z>-0.0005641695</physm:Z>
            <physm:W>0.9999999</physm:W>
          </physm:Orientation>
        </sim:Pose>
        <sim:Velocity>
          <physm:X>0</physm:X>
          <physm:Y>0</physm:Y>
          <physm:Z>0</physm:Z>
        </sim:Velocity>
        <sim:MassDensity>
          <phys:Mass>10</phys:Mass>
          <phys:InertiaTensor>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:InertiaTensor>
          <phys:CenterOfMass>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>0</physm:W>
            </physm:Orientation>
          </phys:CenterOfMass>
          <phys:Density>0</phys:Density>
          <phys:LinearDamping>0</phys:LinearDamping>
          <phys:AngularDamping>0</phys:AngularDamping>
        </sim:MassDensity>
        <sim:Flags>Dynamic</sim:Flags>
      </sim:State>
      <Flags>None</Flags>
      <ChildCount>0</ChildCount>
      <CapsuleShape>
        <phys:CapsuleState>
          <phys:Name>goldencapsule</phys:Name>
          <phys:ShapeId>Capsule</phys:ShapeId>
          <phys:Dimensions>
            <physm:X>0</physm:X>
            <physm:Y>1.6</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:Dimensions>
          <phys:Radius>0.7</phys:Radius>
          <phys:Material>
            <phys:Name>gcaps</phys:Name>
            <phys:Restitution>0.5</phys:Restitution>
            <phys:DynamicFriction>0.4</phys:DynamicFriction>
            <phys:StaticFriction>0.5</phys:StaticFriction>
            <phys:MaterialIndex>4</phys:MaterialIndex>
          </phys:Material>
          <phys:MassDensity>
            <phys:Mass>10</phys:Mass>
            <phys:InertiaTensor>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:InertiaTensor>
            <phys:CenterOfMass>
              <physm:Position>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>0</physm:W>
              </physm:Orientation>
            </phys:CenterOfMass>
            <phys:Density>0</phys:Density>
            <phys:LinearDamping>0</phys:LinearDamping>
            <phys:AngularDamping>0</phys:AngularDamping>
          </phys:MassDensity>
          <phys:LocalPose>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>1</physm:W>
            </physm:Orientation>
          </phys:LocalPose>
          <phys:TextureFileName />
          <phys:DiffuseColor>
            <physm:X>0.7</physm:X>
            <physm:Y>0.6</physm:Y>
            <physm:Z>0.4</physm:Z>
            <physm:W>1</physm:W>
          </phys:DiffuseColor>
          <phys:EnableContactNotifications>false</phys:EnableContactNotifications>
        </phys:CapsuleState>
      </CapsuleShape>
    </SingleShapeEntity>
    <SingleShapeEntity xmlns:sim="http://schemas.microsoft.com/robotics/2006/04/simulation.html" xmlns:physm="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html" xmlns:phys="http://schemas.microsoft.com/robotics/2006/04/simulation/physics.html" xmlns="http://schemas.microsoft.com/robotics/2006/04/simulationengine.html">
      <sim:State>
        <sim:Name>texsphere</sim:Name>
        <sim:Assets>
          <sim:DefaultTexture>Wood_cherry.jpg</sim:DefaultTexture>
          <sim:Effect>default</sim:Effect>
        </sim:Assets>
        <sim:Pose>
          <physm:Position>
            <physm:X>-4.00028324</physm:X>
            <physm:Y>0.798</physm:Y>
            <physm:Z>-3</physm:Z>
          </physm:Position>
          <physm:Orientation>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>-0.000441152253</physm:Z>
            <physm:W>0.9999999</physm:W>
          </physm:Orientation>
        </sim:Pose>
        <sim:Velocity>
          <physm:X>0</physm:X>
          <physm:Y>0</physm:Y>
          <physm:Z>0</physm:Z>
        </sim:Velocity>
        <sim:MassDensity>
          <phys:Mass>10</phys:Mass>
          <phys:InertiaTensor>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:InertiaTensor>
          <phys:CenterOfMass>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>0</physm:W>
            </physm:Orientation>
          </phys:CenterOfMass>
          <phys:Density>0</phys:Density>
          <phys:LinearDamping>0</phys:LinearDamping>
          <phys:AngularDamping>0</phys:AngularDamping>
        </sim:MassDensity>
        <sim:Flags>Dynamic</sim:Flags>
      </sim:State>
      <Flags>None</Flags>
      <ChildCount>0</ChildCount>
      <SphereShape>
        <phys:SphereState>
          <phys:Name>texsphere</phys:Name>
          <phys:ShapeId>Sphere</phys:ShapeId>
          <phys:Dimensions>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:Dimensions>
          <phys:Radius>0.8</phys:Radius>
          <phys:Material>
            <phys:Name>tphere</phys:Name>
            <phys:Restitution>0.5</phys:Restitution>
            <phys:DynamicFriction>0.4</phys:DynamicFriction>
            <phys:StaticFriction>0.5</phys:StaticFriction>
            <phys:MaterialIndex>5</phys:MaterialIndex>
          </phys:Material>
          <phys:MassDensity>
            <phys:Mass>10</phys:Mass>
            <phys:InertiaTensor>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:InertiaTensor>
            <phys:CenterOfMass>
              <physm:Position>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>0</physm:W>
              </physm:Orientation>
            </phys:CenterOfMass>
            <phys:Density>0</phys:Density>
            <phys:LinearDamping>0</phys:LinearDamping>
            <phys:AngularDamping>0</phys:AngularDamping>
          </phys:MassDensity>
          <phys:LocalPose>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>1</physm:W>
            </physm:Orientation>
          </phys:LocalPose>
          <phys:TextureFileName />
          <phys:DiffuseColor>
            <physm:X>0.5</physm:X>
            <physm:Y>0.5</physm:Y>
            <physm:Z>0.5</physm:Z>
            <physm:W>1</physm:W>
          </phys:DiffuseColor>
          <phys:EnableContactNotifications>false</phys:EnableContactNotifications>
        </phys:SphereState>
      </SphereShape>
    </SingleShapeEntity>
    <SingleShapeEntity xmlns:sim="http://schemas.microsoft.com/robotics/2006/04/simulation.html" xmlns:physm="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html" xmlns:phys="http://schemas.microsoft.com/robotics/2006/04/simulation/physics.html" xmlns="http://schemas.microsoft.com/robotics/2006/04/simulationengine.html">
      <sim:State>
        <sim:Name>texcapsule</sim:Name>
        <sim:Assets>
          <sim:DefaultTexture>cellfloor.jpg</sim:DefaultTexture>
          <sim:Effect>default</sim:Effect>
        </sim:Assets>
        <sim:Pose>
          <physm:Position>
            <physm:X>-3.99939466</physm:X>
            <physm:Y>1.49799955</physm:Y>
            <physm:Z>-5.000036</physm:Z>
          </physm:Position>
          <physm:Orientation>
            <physm:X>2.99541011E-06</physm:X>
            <physm:Y>-1.29749014E-05</physm:Y>
            <physm:Z>-0.0005676432</physm:Z>
            <physm:W>0.9999999</physm:W>
          </physm:Orientation>
        </sim:Pose>
        <sim:Velocity>
          <physm:X>0</physm:X>
          <physm:Y>0</physm:Y>
          <physm:Z>0</physm:Z>
        </sim:Velocity>
        <sim:MassDensity>
          <phys:Mass>10</phys:Mass>
          <phys:InertiaTensor>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:InertiaTensor>
          <phys:CenterOfMass>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>0</physm:W>
            </physm:Orientation>
          </phys:CenterOfMass>
          <phys:Density>0</phys:Density>
          <phys:LinearDamping>0</phys:LinearDamping>
          <phys:AngularDamping>0</phys:AngularDamping>
        </sim:MassDensity>
        <sim:Flags>Dynamic</sim:Flags>
      </sim:State>
      <Flags>None</Flags>
      <ChildCount>0</ChildCount>
      <CapsuleShape>
        <phys:CapsuleState>
          <phys:Name>texcapsule</phys:Name>
          <phys:ShapeId>Capsule</phys:ShapeId>
          <phys:Dimensions>
            <physm:X>0</physm:X>
            <physm:Y>1.6</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:Dimensions>
          <phys:Radius>0.7</phys:Radius>
          <phys:Material>
            <phys:Name>tcaps</phys:Name>
            <phys:Restitution>0.5</phys:Restitution>
            <phys:DynamicFriction>0.4</phys:DynamicFriction>
            <phys:StaticFriction>0.5</phys:StaticFriction>
            <phys:MaterialIndex>6</phys:MaterialIndex>
          </phys:Material>
          <phys:MassDensity>
            <phys:Mass>10</phys:Mass>
            <phys:InertiaTensor>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:InertiaTensor>
            <phys:CenterOfMass>
              <physm:Position>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>0</physm:W>
              </physm:Orientation>
            </phys:CenterOfMass>
            <phys:Density>0</phys:Density>
            <phys:LinearDamping>0</phys:LinearDamping>
            <phys:AngularDamping>0</phys:AngularDamping>
          </phys:MassDensity>
          <phys:LocalPose>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>1</physm:W>
            </physm:Orientation>
          </phys:LocalPose>
          <phys:TextureFileName />
          <phys:DiffuseColor>
            <physm:X>0.5</physm:X>
            <physm:Y>0.5</physm:Y>
            <physm:Z>0.5</physm:Z>
            <physm:W>1</physm:W>
          </phys:DiffuseColor>
          <phys:EnableContactNotifications>false</phys:EnableContactNotifications>
        </phys:CapsuleState>
      </CapsuleShape>
    </SingleShapeEntity>
    <LegoNXTTribot xmlns:sim="http://schemas.microsoft.com/robotics/2006/04/simulation.html" xmlns:physm="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html" xmlns:phys="http://schemas.microsoft.com/robotics/2006/04/simulation/physics.html" xmlns="http://schemas.microsoft.com/robotics/2006/04/simulationengine.html">
      <sim:State>
        <sim:Name>LegoNXTMotorBase</sim:Name>
        <sim:Assets>
          <sim:Mesh>LegoNXTTribot.bos</sim:Mesh>
        </sim:Assets>
        <sim:Pose>
          <physm:Position>
            <physm:X>1.99956572</physm:X>
            <physm:Y>-0.00100000354</physm:Y>
            <physm:Z>0.00186561467</physm:Z>
          </physm:Position>
          <physm:Orientation>
            <physm:X>-3.3712102E-09</physm:X>
            <physm:Y>0.0017431993</physm:Y>
            <physm:Z>2.54021737E-09</physm:Z>
            <physm:W>0.9999985</physm:W>
          </physm:Orientation>
        </sim:Pose>
        <sim:Velocity>
          <physm:X>6.871611E-11</physm:X>
          <physm:Y>6.78537365E-11</physm:Y>
          <physm:Z>1.1952304E-08</physm:Z>
        </sim:Velocity>
        <sim:AngularVelocity>
          <physm:X>2.0439586E-07</physm:X>
          <physm:Y>5.624254E-10</physm:Y>
          <physm:Z>-1.82301374E-09</physm:Z>
        </sim:AngularVelocity>
        <sim:MassDensity>
          <phys:Mass>0.501</phys:Mass>
          <phys:InertiaTensor>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:InertiaTensor>
          <phys:CenterOfMass>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>0</physm:W>
            </physm:Orientation>
          </phys:CenterOfMass>
          <phys:Density>0</phys:Density>
          <phys:LinearDamping>0</phys:LinearDamping>
          <phys:AngularDamping>0</phys:AngularDamping>
        </sim:MassDensity>
        <sim:Flags>Dynamic</sim:Flags>
      </sim:State>
      <Flags>None</Flags>
      <ChildCount>1</ChildCount>
      <ReferenceFrame>Global</ReferenceFrame>
      <ServiceContract>http://schemas.microsoft.com/robotics/simulation/services/2006/05/simulateddifferentialdrive.html</ServiceContract>
      <MeshScale>
        <physm:X>1</physm:X>
        <physm:Y>1</physm:Y>
        <physm:Z>1</physm:Z>
      </MeshScale>
      <MeshRotation>
        <physm:X>0</physm:X>
        <physm:Y>0</physm:Y>
        <physm:Z>0</physm:Z>
      </MeshRotation>
      <MeshTranslation>
        <physm:X>0</physm:X>
        <physm:Y>0</physm:Y>
        <physm:Z>0</physm:Z>
      </MeshTranslation>
      <IsEnabled>false</IsEnabled>
      <MotorTorqueScaling>30</MotorTorqueScaling>
      <RightWheel>
        <sim:State>
          <sim:Name>LegoNXTMotorBase:Right wheel</sim:Name>
          <sim:Assets>
            <sim:Mesh>LegoNXTTribotWheel.bos</sim:Mesh>
          </sim:Assets>
          <sim:Pose>
            <physm:Position>
              <physm:X>1.99956572</physm:X>
              <physm:Y>-0.00100000354</physm:Y>
              <physm:Z>0.00186561467</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>-3.3712102E-09</physm:X>
              <physm:Y>0.0017431993</physm:Y>
              <physm:Z>2.54021737E-09</physm:Z>
              <physm:W>0.9999985</physm:W>
            </physm:Orientation>
          </sim:Pose>
          <sim:Velocity>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </sim:Velocity>
          <sim:AngularVelocity>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </sim:AngularVelocity>
          <sim:MassDensity>
            <phys:Mass>0</phys:Mass>
            <phys:InertiaTensor>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:InertiaTensor>
            <phys:CenterOfMass>
              <physm:Position>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>0</physm:W>
              </physm:Orientation>
            </phys:CenterOfMass>
            <phys:Density>0</phys:Density>
            <phys:LinearDamping>0</phys:LinearDamping>
            <phys:AngularDamping>0</phys:AngularDamping>
          </sim:MassDensity>
          <sim:Flags>Dynamic</sim:Flags>
        </sim:State>
        <Flags>None</Flags>
        <ChildCount>0</ChildCount>
        <ReferenceFrame>Global</ReferenceFrame>
        <MeshScale>
          <physm:X>1</physm:X>
          <physm:Y>1</physm:Y>
          <physm:Z>1</physm:Z>
        </MeshScale>
        <MeshRotation>
          <physm:X>0</physm:X>
          <physm:Y>180</physm:Y>
          <physm:Z>0</physm:Z>
        </MeshRotation>
        <MeshTranslation>
          <physm:X>0</physm:X>
          <physm:Y>0</physm:Y>
          <physm:Z>0</physm:Z>
        </MeshTranslation>
        <WheelShape>
          <phys:WheelState>
            <phys:Name>LegoNXTMotorBase/front right wheel</phys:Name>
            <phys:ShapeId>Wheel</phys:ShapeId>
            <phys:Dimensions>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:Dimensions>
            <phys:Radius>0.025</phys:Radius>
            <phys:Material>
              <phys:Name>default wheel material</phys:Name>
              <phys:Restitution>0</phys:Restitution>
              <phys:DynamicFriction>0</phys:DynamicFriction>
              <phys:StaticFriction>0</phys:StaticFriction>
              <phys:MaterialIndex>10</phys:MaterialIndex>
            </phys:Material>
            <phys:MassDensity>
              <phys:Mass>0.01</phys:Mass>
              <phys:InertiaTensor>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </phys:InertiaTensor>
              <phys:CenterOfMass>
                <physm:Position>
                  <physm:X>0</physm:X>
                  <physm:Y>0</physm:Y>
                  <physm:Z>0</physm:Z>
                </physm:Position>
                <physm:Orientation>
                  <physm:X>0</physm:X>
                  <physm:Y>0</physm:Y>
                  <physm:Z>0</physm:Z>
                  <physm:W>0</physm:W>
                </physm:Orientation>
              </phys:CenterOfMass>
              <phys:Density>0</phys:Density>
              <phys:LinearDamping>0</phys:LinearDamping>
              <phys:AngularDamping>0</phys:AngularDamping>
            </phys:MassDensity>
            <phys:LocalPose>
              <physm:Position>
                <physm:X>0.0525</physm:X>
                <physm:Y>0.025</physm:Y>
                <physm:Z>-0.005</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>-0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>1</physm:W>
              </physm:Orientation>
            </phys:LocalPose>
            <phys:TextureFileName />
            <phys:DiffuseColor>
              <physm:X>0.5</physm:X>
              <physm:Y>0.5</physm:Y>
              <physm:Z>0.5</physm:Z>
              <physm:W>1</physm:W>
            </phys:DiffuseColor>
            <phys:EnableContactNotifications>false</phys:EnableContactNotifications>
            <phys:InnerRadius>0.0175</phys:InnerRadius>
            <phys:SuspensionTravel>0</phys:SuspensionTravel>
            <phys:Flags>OverrideAxleSpeed</phys:Flags>
            <phys:AxleSpeed>0</phys:AxleSpeed>
            <phys:BrakeTorque>0</phys:BrakeTorque>
          </phys:WheelState>
        </WheelShape>
        <Rotations>0</Rotations>
      </RightWheel>
      <LeftWheel>
        <sim:State>
          <sim:Name>LegoNXTMotorBase:Left wheel</sim:Name>
          <sim:Assets>
            <sim:Mesh>LegoNXTTribotWheel.bos</sim:Mesh>
          </sim:Assets>
          <sim:Pose>
            <physm:Position>
              <physm:X>1.99956572</physm:X>
              <physm:Y>-0.00100000354</physm:Y>
              <physm:Z>0.00186561467</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>-3.3712102E-09</physm:X>
              <physm:Y>0.0017431993</physm:Y>
              <physm:Z>2.54021737E-09</physm:Z>
              <physm:W>0.9999985</physm:W>
            </physm:Orientation>
          </sim:Pose>
          <sim:Velocity>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </sim:Velocity>
          <sim:AngularVelocity>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </sim:AngularVelocity>
          <sim:MassDensity>
            <phys:Mass>0</phys:Mass>
            <phys:InertiaTensor>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:InertiaTensor>
            <phys:CenterOfMass>
              <physm:Position>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>0</physm:W>
              </physm:Orientation>
            </phys:CenterOfMass>
            <phys:Density>0</phys:Density>
            <phys:LinearDamping>0</phys:LinearDamping>
            <phys:AngularDamping>0</phys:AngularDamping>
          </sim:MassDensity>
          <sim:Flags>Dynamic</sim:Flags>
        </sim:State>
        <Flags>None</Flags>
        <ChildCount>0</ChildCount>
        <ReferenceFrame>Global</ReferenceFrame>
        <MeshScale>
          <physm:X>1</physm:X>
          <physm:Y>1</physm:Y>
          <physm:Z>1</physm:Z>
        </MeshScale>
        <MeshRotation>
          <physm:X>0</physm:X>
          <physm:Y>0</physm:Y>
          <physm:Z>0</physm:Z>
        </MeshRotation>
        <MeshTranslation>
          <physm:X>0</physm:X>
          <physm:Y>0</physm:Y>
          <physm:Z>0</physm:Z>
        </MeshTranslation>
        <WheelShape>
          <phys:WheelState>
            <phys:Name>LegoNXTMotorBase/front left wheel</phys:Name>
            <phys:ShapeId>Wheel</phys:ShapeId>
            <phys:Dimensions>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:Dimensions>
            <phys:Radius>0.025</phys:Radius>
            <phys:Material>
              <phys:Name>default wheel material</phys:Name>
              <phys:Restitution>0</phys:Restitution>
              <phys:DynamicFriction>0</phys:DynamicFriction>
              <phys:StaticFriction>0</phys:StaticFriction>
              <phys:MaterialIndex>9</phys:MaterialIndex>
            </phys:Material>
            <phys:MassDensity>
              <phys:Mass>0.01</phys:Mass>
              <phys:InertiaTensor>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </phys:InertiaTensor>
              <phys:CenterOfMass>
                <physm:Position>
                  <physm:X>0</physm:X>
                  <physm:Y>0</physm:Y>
                  <physm:Z>0</physm:Z>
                </physm:Position>
                <physm:Orientation>
                  <physm:X>0</physm:X>
                  <physm:Y>0</physm:Y>
                  <physm:Z>0</physm:Z>
                  <physm:W>0</physm:W>
                </physm:Orientation>
              </phys:CenterOfMass>
              <phys:Density>0</phys:Density>
              <phys:LinearDamping>0</phys:LinearDamping>
              <phys:AngularDamping>0</phys:AngularDamping>
            </phys:MassDensity>
            <phys:LocalPose>
              <physm:Position>
                <physm:X>-0.0525</physm:X>
                <physm:Y>0.025</physm:Y>
                <physm:Z>-0.005</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>-0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>1</physm:W>
              </physm:Orientation>
            </phys:LocalPose>
            <phys:TextureFileName />
            <phys:DiffuseColor>
              <physm:X>0.5</physm:X>
              <physm:Y>0.5</physm:Y>
              <physm:Z>0.5</physm:Z>
              <physm:W>1</physm:W>
            </phys:DiffuseColor>
            <phys:EnableContactNotifications>false</phys:EnableContactNotifications>
            <phys:InnerRadius>0.0175</phys:InnerRadius>
            <phys:SuspensionTravel>0</phys:SuspensionTravel>
            <phys:Flags>OverrideAxleSpeed</phys:Flags>
            <phys:AxleSpeed>0</phys:AxleSpeed>
            <phys:BrakeTorque>0</phys:BrakeTorque>
          </phys:WheelState>
        </WheelShape>
        <Rotations>0</Rotations>
      </LeftWheel>
      <ChassisShape>
        <phys:BoxState>
          <phys:Name>LegoNXTMotorBase/Chassis</phys:Name>
          <phys:ShapeId>Box</phys:ShapeId>
          <phys:Dimensions>
            <physm:X>0.105</physm:X>
            <physm:Y>0.12</physm:Y>
            <physm:Z>0.14</physm:Z>
          </phys:Dimensions>
          <phys:Radius>0</phys:Radius>
          <phys:Material>
            <phys:Name>high friction</phys:Name>
            <phys:Restitution>0</phys:Restitution>
            <phys:DynamicFriction>1</phys:DynamicFriction>
            <phys:StaticFriction>20</phys:StaticFriction>
            <phys:MaterialIndex>8</phys:MaterialIndex>
          </phys:Material>
          <phys:MassDensity>
            <phys:Mass>0.5</phys:Mass>
            <phys:InertiaTensor>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:InertiaTensor>
            <phys:CenterOfMass>
              <physm:Position>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>0</physm:W>
              </physm:Orientation>
            </phys:CenterOfMass>
            <phys:Density>0</phys:Density>
            <phys:LinearDamping>0</phys:LinearDamping>
            <phys:AngularDamping>0</phys:AngularDamping>
          </phys:MassDensity>
          <phys:LocalPose>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0.0749999955</physm:Y>
              <physm:Z>0.025</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>1</physm:W>
            </physm:Orientation>
          </phys:LocalPose>
          <phys:TextureFileName />
          <phys:DiffuseColor>
            <physm:X>0.5</physm:X>
            <physm:Y>0.5</physm:Y>
            <physm:Z>0.5</physm:Z>
            <physm:W>1</physm:W>
          </phys:DiffuseColor>
          <phys:EnableContactNotifications>false</phys:EnableContactNotifications>
        </phys:BoxState>
      </ChassisShape>
      <CasterWheelShape>
        <phys:SphereState>
          <phys:Name>LegoNXTMotorBase/Caster wheel</phys:Name>
          <phys:ShapeId>Sphere</phys:ShapeId>
          <phys:Dimensions>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:Dimensions>
          <phys:Radius>0.0125</phys:Radius>
          <phys:Material>
            <phys:Name>small friction with anisotropy</phys:Name>
            <phys:Restitution>0.5</phys:Restitution>
            <phys:DynamicFriction>0.5</phys:DynamicFriction>
            <phys:StaticFriction>1</phys:StaticFriction>
            <phys:MaterialIndex>7</phys:MaterialIndex>
            <phys:Advanced>
              <phys:AnisotropicStaticFriction>0.4</phys:AnisotropicStaticFriction>
              <phys:AnisotropicDynamicFriction>0.3</phys:AnisotropicDynamicFriction>
              <phys:AnisotropyDirection>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>1</physm:Z>
              </phys:AnisotropyDirection>
              <phys:RestitutionCombineMode>Unspecified</phys:RestitutionCombineMode>
              <phys:FrictionCombineMode>Unspecified</phys:FrictionCombineMode>
            </phys:Advanced>
          </phys:Material>
          <phys:MassDensity>
            <phys:Mass>0.001</phys:Mass>
            <phys:InertiaTensor>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </phys:InertiaTensor>
            <phys:CenterOfMass>
              <physm:Position>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>0</physm:W>
              </physm:Orientation>
            </phys:CenterOfMass>
            <phys:Density>0</phys:Density>
            <phys:LinearDamping>0</phys:LinearDamping>
            <phys:AngularDamping>0</phys:AngularDamping>
          </phys:MassDensity>
          <phys:LocalPose>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0.0125</physm:Y>
              <physm:Z>0.125</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>1</physm:W>
            </physm:Orientation>
          </phys:LocalPose>
          <phys:TextureFileName />
          <phys:DiffuseColor>
            <physm:X>0.5</physm:X>
            <physm:Y>0.5</physm:Y>
            <physm:Z>0.5</physm:Z>
            <physm:W>1</physm:W>
          </phys:DiffuseColor>
          <phys:EnableContactNotifications>false</phys:EnableContactNotifications>
        </phys:SphereState>
      </CasterWheelShape>
      <RotateDegreesAngleThreshold>0.20000000298023224</RotateDegreesAngleThreshold>
      <TimeoutSeconds>30</TimeoutSeconds>
    </LegoNXTTribot>
    <BumperArrayEntity xmlns:sim="http://schemas.microsoft.com/robotics/2006/04/simulation.html" xmlns:physm="http://schemas.microsoft.com/robotics/2006/07/physicalmodel.html" xmlns:phys="http://schemas.microsoft.com/robotics/2006/04/simulation/physics.html" xmlns="http://schemas.microsoft.com/robotics/2006/04/simulationengine.html">
      <sim:State>
        <sim:Name>LegoNXTBumpers</sim:Name>
        <sim:Assets>
          <sim:Effect>default</sim:Effect>
        </sim:Assets>
        <sim:Pose>
          <physm:Position>
            <physm:X>1.999394</physm:X>
            <physm:Y>-0.002000004</physm:Y>
            <physm:Z>-0.00087569654</physm:Z>
          </physm:Position>
          <physm:Orientation>
            <physm:X>4.883475E-09</physm:X>
            <physm:Y>-0.00297435746</physm:Y>
            <physm:Z>1.83261706E-09</physm:Z>
            <physm:W>0.9999956</physm:W>
          </physm:Orientation>
        </sim:Pose>
        <sim:Velocity>
          <physm:X>0</physm:X>
          <physm:Y>0</physm:Y>
          <physm:Z>0</physm:Z>
        </sim:Velocity>
        <sim:MassDensity>
          <phys:Mass>0</phys:Mass>
          <phys:InertiaTensor>
            <physm:X>0</physm:X>
            <physm:Y>0</physm:Y>
            <physm:Z>0</physm:Z>
          </phys:InertiaTensor>
          <phys:CenterOfMass>
            <physm:Position>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
            </physm:Position>
            <physm:Orientation>
              <physm:X>0</physm:X>
              <physm:Y>0</physm:Y>
              <physm:Z>0</physm:Z>
              <physm:W>0</physm:W>
            </physm:Orientation>
          </phys:CenterOfMass>
          <phys:Density>0</phys:Density>
          <phys:LinearDamping>0</phys:LinearDamping>
          <phys:AngularDamping>0</phys:AngularDamping>
        </sim:MassDensity>
        <sim:Flags>Dynamic</sim:Flags>
      </sim:State>
      <Flags>None</Flags>
      <ChildCount>0</ChildCount>
      <Shapes>
        <BoxShape>
          <phys:BoxState>
            <phys:Name>LegoNXTBumpers/front</phys:Name>
            <phys:ShapeId>Box</phys:ShapeId>
            <phys:Dimensions>
              <physm:X>0.023</physm:X>
              <physm:Y>0.023</physm:Y>
              <physm:Z>0.045</physm:Z>
            </phys:Dimensions>
            <phys:Radius>0</phys:Radius>
            <phys:MassDensity>
              <phys:Mass>0.001</phys:Mass>
              <phys:InertiaTensor>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
              </phys:InertiaTensor>
              <phys:CenterOfMass>
                <physm:Position>
                  <physm:X>0</physm:X>
                  <physm:Y>0</physm:Y>
                  <physm:Z>0</physm:Z>
                </physm:Position>
                <physm:Orientation>
                  <physm:X>0</physm:X>
                  <physm:Y>0</physm:Y>
                  <physm:Z>0</physm:Z>
                  <physm:W>0</physm:W>
                </physm:Orientation>
              </phys:CenterOfMass>
              <phys:Density>0</phys:Density>
              <phys:LinearDamping>0</phys:LinearDamping>
              <phys:AngularDamping>0</phys:AngularDamping>
            </phys:MassDensity>
            <phys:LocalPose>
              <physm:Position>
                <physm:X>0</physm:X>
                <physm:Y>0.063</physm:Y>
                <physm:Z>-0.09</physm:Z>
              </physm:Position>
              <physm:Orientation>
                <physm:X>0</physm:X>
                <physm:Y>0</physm:Y>
                <physm:Z>0</physm:Z>
                <physm:W>1</physm:W>
              </physm:Orientation>
            </phys:LocalPose>
            <phys:TextureFileName />
            <phys:DiffuseColor>
              <physm:X>0.5</physm:X>
              <physm:Y>0.5</physm:Y>
              <physm:Z>0.5</physm:Z>
              <physm:W>1</physm:W>
            </phys:DiffuseColor>
            <phys:EnableContactNotifications>true</phys:EnableContactNotifications>
          </phys:BoxState>
        </BoxShape>
      </Shapes>
    </BumperArrayEntity>
  </SerializedEntities>
</SimulationState>